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ABSTRACT 


The  tracking  accuracy  of  a  missile  target  seeker  depends  on  many  variables.  For 
a  target  seeker  using  a  gimbaled  platform,  an  important  variable  is  the  friction  induced 
by  the  preloaded  bearings,  and  by  the  short  wires  which  connect  the  target  detector 
with  the  rest  of  the  seeker's  electronics.  This  friction  force  is  nonlinear  and  sufficiently 
large  enough  such  that  accurate  position  tracking  of  a  target,  whether  stationary'  or 
moving,  is  difficult.  Conventional  control  methods  such  as  P.D.  (proportional  plus 
derivative)  or  P.I.D.  (proportional  plus  derivati  ve  plus  integral)  control  action  can  not 
satisfactorily  meet  the  error  criteria.  To  overcome  the  deficiency  of  these  two  methods, 
a  model-reference  method  has  been  synthesized,  relying  on  idealized  predictor  corrector 
control  to  improve  the  tracking  accuracy  of  the  missile  seeker.  Computer  simulations 
using  the  Dynamic  Simulation  Language  have  demonstrated  the  superior  performance 
expected  from  this  method. 


Accesion  Fbr 


"1 


NTfS  CRAftl 
or  1C  TAB 

U:iinno*i.\'.e.l 

Jtii.tnicai'cn 


- * 

U  I 

u  ; 

i 


By  . 

Di.it'  ib.iticn/ 


- 4 


.'uilol’ility  Codes 


!  Avail  a-'.j  /  or 


iol'L'Cld! 


3 


TABLE  OF  CONTENTS 


I.  INTRODUCTION . 8 

A.  BACKGROUND  . 8 

B.  RECENT  DEVELOPMENTS  IN  CONTROL . 9 

C.  OBJECTIVE . 10 

D.  METHOD  AND  APPROACH . 10 

II.  ANALYTICAL  MODELING . 11 

A.  INTRODUCTION . 11 

B.  EQUATION  OF  MOTION . 11 

C.  FRICTION  MODEL . 12 

D  BLOCK  DIAGRAM  OF  BASIC  CONTROL  SYSTEM . 14 

E.  MODEL-REFERENCE  CONTROL  . 16 

F.  INPUT  SIGNAL  MODEL  . 17 

HI.  COMPUTER  SIMULATION  METHOD  . 20 

A.  INTRODUCTION . 20 

B.  GEOMETRIC  DESCRIPTION  . 20 

C.  ACCELERATION  SIMULATION  . 20 

D.  DSL  CODING . 20 

IV.  SIMULATION  RESULTS  . 23 

A.  INTRODUCTION . 23 

B.  EFFECT  OF  FRICTION  ON  ACCURACY . 23 

C.  EFFECT  OF  THE  Kj  . 33 

D.  EFFECT  OF  SPRING  CONSTANT  . 33 

E.  EFFECT  OF  INTEGRAL  GAIN  TIME  CONSTANT . 42 

F.  EFFECT  OF  G, . 42 

G.  EFFECT  OF  Ji  PREDICTION  ERROR  . 51 

H.  EFFECT  OF  UNBALANCED  SYSTEM . 51 

I.  EFFECT  OF  ACCELERATION  . 60 


4 


V.  DISCUSSION  AND  RECOMMENDATION . 65 

A.  INTRODUCTION . 65 

B.  DISCUSSION . 65 

C.  RECOMMENDATION . 66 

APPENDIX  A:  DSL  LISTINGS  (PD.  PID  CONTROL) . 67 

APPENDIX  B:  DSL  LISTINGS  (PC  CONTROL) . 70 

LIST  OF  REFERENCES . 73 

INITIAL  DISTRIBUTION  LIST . 74 


5 


LIST  OF  FIGL  RES 


1. 1  Typical  Seeker  Configuration . 9 

2.1  Free  Body  Diagram  of  the  Platform . 12 

2.2  Friction  Model  of  the  Bearings  and  Wires . 13 

2.3  Response  of  the  Friction  Model .  14 

2.4  Block  Diagram . 15 

2.5  Model* Reference  Control  Action . IS 

3.1  D.S.L.  Program  Flowchart . 22 

4. 1  Balanced  System,  PD  Control,  No  Friction . 25 

4.2  pi -0.1,  Kj  -  15.0,  K2- 0.5,  *-0.05 . 26 

4.3  pi  — 0.2,  K,  -  15.0,  Kj-0.5,  *-0.05 . 27 

4.4  pi -0.3,  K,-  15.0,  K2- 0.5,  *-0.05 . 28 

4.5  pi  — 0.1,  Kj  -  15.0,  Kj  — 0.5,  *-0.05,  PID  Control  T,—  1.0 . 29 

4.6  |i  — 0.2,  K,-  15.0,  K2-0.5,  *-0.05,  PID  Control  T.-  1.0 . 30 

1.7  p-0.3,  K,  -  15.0,  Kj-0.5,  *-0.05,  PID  Control  T,-  1.0 . 31 

4.8  Position  Error  Vs  Gain  Constant  K,  . 32 

4.9  p-0.3.  K,- 2.0,  *-0.05  . 34 

4.10  p-0.3,  Kj- 5.0, *-0.05  . 35 

4.1 1  pi  -  0.3,  K,-  15.0,  *-0.05 . 36 

4.12  p-0.3.  K,  -  15.0,  *-0.05,  Sin  Input . 37 

4.13  p-0.3,  Kj- 30.0, *-0.05,  Sin  Input . 38 

4.14  pi -0.3,  K,  -  1000.0,  *-0.05,  Sin  Input . 39 

4.15  p-0.3,  K,- 5.0,  *-0.001 . 40 

4.16  p-0.3,  Kj-5.0,  *-0.01  . 41 

4.17  p  —  0.3,  Kj-5.0,  *—0.1  . 43 

4.18  Balanced  System,  PD  Control,  No  Friction,  Sin  Input . 44 

4.19  p—0.3,  Kj-5.0, *-0.0l.  Sin  Input . 45 

4.20  pi -0.3,  Kj-5.0, *- 0.1,  Sin  Input . 46 

4.21  p-0.1,  K,- 15.0,  *-0.05,  PID  Control,  Tj-  2 . 47 


6 


4.22  *-0.I,  K,  -  15.0,  5-0.05,  PID  Control,  T.  -  3 . 48 

4.23  *-0.3,  K,- 30.0, 5 -0.05,  *m- 0.3,  5m- 0.05,  G,- 30.0  . 49 

4.24  *-0.3,  K,- 30.0, 5  -  0.05,  *m " 0.3,  5m- 0.05,  G,  - 500.0  .  50 

4  25  *-0.3,  Kt- 15.0, 5 -0.05,  *m- 0.3,  6m- 0.05,  G,- 3000.0  .  52 

4.26  JI-0.1,  K,- 15.0,5-0.05,  pm-0.3.8m-0.05,Gl- 3000.0  .  53 

4.27  *-0.2,  K,-  15.0,5-0.05,  *m-0.3,  6m« 0.05,  G,«  3000.0  .  54 

4.28  *-0.4,  K,- 15.0,  5 -0.05,  *m- 0.3,  6m«  0.05,  G,- 3000.0  .  55 

4.29  *-0.5,  K,- 15.0,  5 -0.05,  *m- 0.3,  6m- 0.05,  Gj- 3000.0  .  56 

4.30  *-0.3,  K,«  15.0,  5-0.05,  PD  Control,  Zm -  3864.0,  Y  -0.1, 

Z0  ■  0.2 . 57 

4.31  *-0.3,  K,-  15.0,  5-0.05,  PD  Control,  Zm- 3864.0,  yo-0.2, 

Z0-04 . 58 

4.32  p-0.3,  Kj  -  15.0,  5-0.05.  PD  Control.  Zm-  3864.0,  yo-0.2, 

Z0  —  0.6 . 59 

4.33  *-0.3,  Kj  -  15.0,  5-0.05,  Zm-  3864.0,  PD  Control,  step  response . 61 

4.34  *  -  0.3,  K,  - 15.0,  5  -  0.05,  Zm  -  3864.0,  PD  Control,  sin  response . 62 

4.35  *-0.3,  Kj  -  15.0,  5-0.05,  Zm -  3864.0,  M-F  Control,  step  response . 63 

4.36  *-0.3,  Kl  -  15.0,  5-0.05,  ZM -  3864.0,  M-F  Control,  sin  response . 64 


7 


I.  INTRODUCTION 


A.  BACKGROUND 

A  typical  air-to-air  missile  seeker  might  consist  of  a  set  of  focusing  optics,  a 
detector,  signal  processing  electronics,  gyros,  rate  and  position  sensors,  all  mounted  on 
a  gimbaled  platform  as  illustrated  in  Figure  1.1.  A  missile  target  seeker's  function  is  to 
detect  and  to  track  a  target,  whether  stationary  or  moving,  until  the  target  is 
neutralized.  There  are  many  variables  which  affect  the  accuracy  of  the  seeker. 
Mechanical  variables  include  friction,  inertia,  location  of  center  of  gravity,  and 
vibration.  Electrical  variables  include  servos,  signal  processing  limitations,  and  noise. 
Other  variables  such  as  thermal  noise,  external  disturbances,  electro-magnetic 
interferences,  all  play  an  important  role  in  the  tracking  accuracy  of  a  missile  seeker. 
One  of  the  most  important  considerations  is  the  effect  of  friction  on  the  tracking 
accuracy.  For  a  seeker  with  a  gimbaled  platform,  the  friction  primarily  comes  from  the 
preloaded  bearings  and  from  the  wires  connecting  the  platform  electronics  and  the 
seeker  electronics  located  off  the  platform.  This  type  of  friction  is  nonlinear  and  its 
direction  changes  in  relation  to  the  motion  of  the  target.  Excessive  friction  causes 
'sticking'  behavior  and  impairs  accurate  tracking. 

Control  of  the  position  of  a  massive  object  in  the  presence  of  friction  is  not  an 
easy  task  and  requires  high  positional  feedback  gain  with  accompanying  high  drive 
stiffness  for  accuracy.  Not  only  does  this  problem  arise  in  target  seekers,  but  also  in 
optical  tracking  telescopes,  and  robotic  manipulators.  Classical  control  techniques  for 
accurate  tracking  have  been  based  on  the  provision  of  a  drive  torque  being 
proportional  to  angular  position  error  with  dynamic  compensation  based  on  integral 
and.  or  derivative  action.  Target  position  is  sensed  by  the  optical  apparatus  as  an 
angular  error  from  the  straight  line  pointing  vector.  Platform  drive  torques  are  then 
commanded  to  drive  the  angular  pointing  error  to  zero  so  that  the  angular  position  of 
the  gimbaled  platform  automatically  aligns  with  the  target.  In  stabilizing  dynamic 
motions,  rate  feedback  from  platform  is  essentially  provided  by  either  the  gyros  or  by  a 
resolver  mounted  opposite  the  torque  motor  on  the  platform.  The  accuracy  of  tracking 
is  limited  by  the  sensitivity  of  the  feedback  elements  and  is  further  impaired  by 
vibration  and  sensor  noise  (Ref.  1|  Normally,  high  positional  feedback  gain  results  in  a 
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high  drive  itiflheu,  but,  with  the  presence  or  vibration  and  noise,  high  stiffness 
increases  errors.  Modem  stabilization  techniques  are  being  sought  that  overcome  the 
need  Tor  high  feedback  gains. 

In  this  thesis,  the  use  of  a  model  based  predictor  corrector  control  has  been 
demonstrated,  including  the  use  of  a  "stick-slip"  friction  model  for  predicting  the  added 
torque  required  to  compensate  tor  frictional  induced  inaccuracies. 


i,:  Torque  Motor 


Figure  1.1  Typical  Seeker  Configuration. 


B,  RECENT  DEVELOPMENTS  IN  CONTROL 

A  ty  pical  method  employed  to  control  the  position  error  of  a  mechanical  system  is 
the  P.D.  (proportional  plus  derivative)  action.  This  control  scheme  works  well  in  most 
control  applications  but  it  has  one  drawback,  the  presence  of  steady  state  error. 
Integral  action  is  usually  added  to  eliminate  the  steady  state  error,  but  it  is  useless  in 
the  presence  of  non-linearity  elements.  Lag  lead  compensation  technique  is  usually 
employed  to  overcome  non-linearity  effects  by  increasing  the  gain  in  the  system  and 
subsequently  lead  to  increase  noise  in  the  system  and  increase  erTor. 

The  use  of  model-reference  controls  increased  in  recent  years.  It  is  found  that  this 
technique  lends  itself  to  the  problem  of  controlling  complex  and  often  non-iinear 
systems.  With  the  adsent  of  modem  microprocessor  based  controls,  techniques  using 
model  following  controls  (Ref.  2|  oiler  advantages  where  a  large  part  of  the  control 
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force  and  effect  can  be  predicted,  rather  that  relying  on  feedback  methods  alone  for 
correction  of  errors.  Model  Reference  Controls  have  been  used  as  an  ideal  response 
generator  for  comparison  with  actual  system  response  so  that  plant  parameter  changes 
can  be  monitored,  identified,  and  control  gains  adjusted  automatically.  Additionally, 
with  particular  emphasis  on  nonlinear  systems  in  robotics,  the  computed  torque 
method  and  sliding  mode  control  design  (Ref.  3)  have  been  proposed  for  providing 
improved  model  following  and  tracking  system  performance. 

C.  OBJECTIVE 

The  effectiveness  of  a  target  tracker  depends  on  its  ability  to  maintain  the  target 
within  its  line  of  sight  regardless  of  the  actions  taken  by  the  target.  This  requires  a 
high  degree  of  accuracy  on  the  part  of  the  seeker  to  response  to  the  motion  of  the 
target.  It  is  demonstrated  that  friction,  among  other  impedimenta,  reduces  the  ability 
of  the  seeker  to  track  a  target.  It  is  the  purpose  of  this  investigation  to  compare 
tracking  performance  with  both  classical  P.I.D.,  P.D.,  and  model-reference  control 
actions  under  the  assumption  of  deterministic  signals.  The  primary  disturbance  is 
considered  to  arise  from  friction  which  is  modeled  here  to  include  coulomb  friction  and 
the  elastic  effects  from  wiring  harnesses. 

D.  METHOD  AND  APPROACH 

The  approach  to  this  problem  begins  with  a  study  of  the  friction  variables  and 
their  effect  on  the  tracking  error.  Then,  the  performance  of  the  classical  control 
actions,  P.D.,  P.I.D.  is  evaluated.  Finally,  a  model-reference  method  has  been 
synthesized  to  improve  the  tracking  accuracy  of  the  seeker.  All  evaluations  were  done 
by  computer  simulation  using  the  Dynamic  Simulation  Language  (D.S.L.)  developed 
for  the  I.B.M.  3033  computer.  The  simulation  is  limited  to  a  single  degree  of  freedom 
gimbal  and  it  is  shown  that  superior  tracking  accuracy  may  be  achieved  using  a  model- 
reference  system  with  nonlinear  friction  force  compensation. 
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II.  ANALYTICAL  MODELING 


A.  INTRODUCTION 

This  chapter  discusses  the  development  of  the  mathematical  model  for  the  target 
seeker  dynamics  in  one  degree  of  freedom  and  the  reference  model  used  for  nonlinear 
friction  compensation.  The  analytical  modeling  begins  with  the  derivation  of  the 
equations  of  motion  for  the  platform  in  the  Y-Z  plane.  The  motions  in  the  other 
planes  are  neglected  at  this  time  to  reduce  the  level  of  complexity.  Even  with  this 
simplification,  the  information  obtained  in  this  study  should  prove  useful  in  gaining  an 
insight  to  the  interaction  of  friction  in  a  dynamic  system.  A  friction  model  based  on  a 
"stick-slip”  concept  will  be  developed  to  model  the  combined  friction  effect  of  the 
bearings  and  wire  harness.  This  is  followed  by  the  presentation  of  the  classical  control 
actions.  A  model-reference  method  to  control  the  position  error  will  be  synthesized  to 
improve  the  tracking  accuracy.  A  brief  discussion  of  the  input  signal  model  will 
complete  this  chapter. 

B.  EQUATION  OF  MOTION 

The  platform,  together  with  the  optics,  detector,  gyros,  signal  processing 
electronics  and  sensors  can  be  modeled  as  a  simple  cylinder  with  a  small  degree  of  out 
of  balance.  The  analysis  begins  with  the  determination  of  the  forces  acting  on  the 
system  as  shown  in  Figure  2.1.  Using  Newton  s  second  law  of  motion  and 
D'Alembert  s  Principle,  the  equation  of  motion  of  the  seeker  is  derived  as, 

( lm  +  mi2)  0  +  F(0.O)  +  mzrtcos0cos<p  -  sinOsintp)  -  Tx  (eqn  2. 1 ) 

where  the  torque,  Tx,  required  to  move  the  platform  through  an  angular  displacement, 
0,  depends  on  the  position  and  velocity  of  the  platform  and  on  the  motor's 
characteristics.  The  friction  term  in  this  equation  is  nonlinear.  It  is  a  function  of  0 
and  0  The  terms  in  z  refer  to  an  axial  acceleration  induced  torque  arising  from  some 
small  out  of  balance  mass  m  located  at  a  distance  r  from  the  geometric  center  making 
an  angle  9  from  the  Y  axis. 
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With  a  typical  d.c.  motor,  the  output  torque  can  be  expressed  for  purposes  of 
position  control  as  the  sum  of  proportional  error  and  rate  terms,  as, 

Tx  "  K,(ec-9)-K28  teqn  2.2) 

where  K(  is  the  motor  gain  constant  and  K2  is  the  velocity  gain  constant.  For  an 
input  command,  0C,  the  required  torque  can  be  calculated  by  Equation  2.2  if  the 
displacement  6  and  velocity  0  of  the  platform  are  known.  The  damping  ratio  s'  2  is 
used  to  provide  proper  damping  of  the  system. 


Z 


Figure  2.1  Free  Body  Diagram  of  the  Platform. 

C.  FRICTION  MODEL 

The  main  contributors  of  friction  in  this  platform  are  the  bearings  aiul  the 
electrical  wires  which  connect  the  platform  electronics  with  that  located  in  the  support 
structure.  A  proper  friction  model  must  begin  with  the  understanding  of  how  these 
two  components  behave.  The  bearing  friction  is  basically  rolling  friction  which  is  a 
function  of  the  surface  roughness  of  the  races  and  of  the  angular  speed  of  the  platform. 
The  wires  act  as  a  ;  ring  which  could  be  quite  stifT  when  they  are  bundled,  or  soft 
when  they  are  lost.  Relative  motion  between  wires  in  a  harness  causes  an  additional 
friction  force  that  is  dependent  on  the  stillness  of  the  harness.  The  combined  friction 


■  —  —  M-ntf  »■  Iffl-Iffl  I'  -  ■ '  -  ■  m  murmaarairatf 
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from  the  two  components  can  be  modeled  as  a  massless  slider  with  a  spring  attached  to 
it  as  shown  in  Figure  2.2. 


l-V  — 1 

—  0 

Massless  Slider 

k 

1  H^V/V/Vr— ' 

// 1  HrfV/l  Spring 

Figure  2.2  Friction  Model  of  the  Bearings  and  Wires. 


The  force  pulling  on  the  spring  stretches  the  spring  by  a  distance  8  until  the 
springs  potential  force  is  overcome.  Then,  the  slider  begins  to  move  to  a  distance  0s. 
The  friction  force  then  is  equal  to  the  product  of  the  spring  constant  and  the  net 
motion  (0-8s)  of  the  spring.  The  spring  constant,  k,  is  a  function  of  the  coefficient  of 
friction  between  the  slider  and  the  surface,  gi.  and  of  the  amount  of  the  allowable 
stretch  on  the  spring.  6.  A  large  value  for  6  represents  a  soft  spring;  and  a  small  value 
for  6  represents  a  stiff  spring.  When  the  direction  is  reversed,  the  force  pushes  on  the 
spring,  compressing  it  until  the  force  is  greater  than  the  spring's  potential  force  and  the 
slider  moves  in  the  opposite  direction.  The  friction  force  of  this  model  is  given  as, 


F 


-*» 

o 


(eqn  2.3) 


When  the  friction  force  is  less  then  the  friction  between  the  two  surfaces,  the  slider 
does  not  move  until  the  friction  force  increases  to  exceed  |i  as  indicated  in  2.4  and  2.5. 

0S  *  05  F  <  Jl  (eqn  2.4) 
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F  >  H 


(cqn  2.5) 


In  reality,  a  friction  force  can  exists  even  though  there  is  no  relative  motion.  A  closer 
look  at  equation  2.3  reveals  the  ability  of  this  model  to  support  a  non-zero  friction 
force.  When  9|  is  zero,  that  is,  the  platform  is  not  rotating,  the  friction  force  is  equal 
to  the  product  of  the  spring  constant  and  0.  A  typical  coulomb  friction  model  would 
have  a  zero  friction  force  when  0.  is  zero.  It  is  the  ability  of  this  model  to  handle 
nonzero  friction  force  which  sets  it  apart  from  conventional  coulomb  friction  model. 
Once  the  force  exceeds  the  friction  force,  the  slider  starts  to  move  with  its  direction 
determined  by  the  direction  of  the  force  as  indicated  in  Equations  2.5.  The  response  of 
the  slider-spring  friction  model  is  illustrated  in  Figure  2.3. 


Figure  2.3  Response  of  the  Friction  Model. 


D.  BLOCK  DIAGRAM  OF  BASIC  CONTROL  SYSTEM 

The  behavior  of  the  system  can  now  be  put  in  a  more  convenient  form  for  control 
analysis  and  simulation.  A  block  diagram,  is  constructed  from  Equations  2. 1  and  2.2. 
Figure  2.4  provides  an  visual  interpretation  of  the  control  system  which  allows  more 
efTcctive  analysis  of  the  problem. 

The  command  signal,  0C,  is  compared  with  the  position  feedback  signal,  0,  to  produce 
an  error  c.  This  signal  is  amplified  by  a  feedforward  gain  K,  in  the  P.D.  control 
method.  The  amplified  signal  is  compared  with  the  velocity  feedback  signal  to  produce 


Figure  2.4  Block  Diagram 
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the  required  torque  to  drive  the  platform.  However,  this  torque  is  reduced  by  the 
friction  torque  caused  by  the  bearings  and  wires.  The  torque  generated  by  the  out  of 
balance  mass  reduces  the  available  torque  even  further.  What  is  left  is  a  greatly 
reduced  torque  which  is  not  necessarily  high  enough  to  drive  the  platform  dynamics  to 
the  desired  position  and  a  position  error  exists.  P.D.  control  action  simply  would  not 
produce  a  zero  position  error.  The  shortcoming  of  this  scheme  is  its  lack  of  history  of 
how  the  error  changes  with  time.  The  integral  action,  shown  as  dotted  outlines  in 
Figure  2.4,  helps  to  reduce  'he  error  by  summing  errors  accumulated  up  to  the  most 
recent  time,  then  an  amplified  average  of  this  error  is  added  to  produce  the  required 
torque.  The  overall  effect  is  better  error  reporting  and  correcting.  Ideally,  this  method 
would  produce  zero  position  error.  Both  the  P.D.  and  P.I.D.  control  suffer  noise 
sensitivity  problems.  When  a  noise,  either  internal  or  external,  is  introduced  to  the 
sy  stem  it  is  amplified  by  the  control  actions  and  accurate  tracking  becomes  difficult. 

E.  MODEL-REFERENCE  CONTROL 

Consider  an  ideal  system  which  has  the  same  basic  inertial  characteristics  as  the 
platform.  This  is  refered  to  as  a  model.  Assuming  the  model  is  perfectly  balanced  and 
neglecting  the  effect  of  friction,  the  ideal  model  dynamics  is  expressed  by  Equation  2.6. 


X  ’  (*qn  16) 

m 

If  this  model  is  rotated  by  a  motor  with  the  output  torque  expressed  as  the  sum  of  a 
positional  error  and  rate  feedback,  the  torque  equation  is  given  as, 

U  -  G1(0c-X)-G2X  (eqn  2.7) 

where  U  is  the  ideal  motor  output  torque,  6c  is  the  command  signal  as  defined  before. 

X  and  X  denotes  the  position  and  velocity'  of  the  model,  respectively.  G(  is  the 

positional  error  gain  and  G2  is  the  velocity  feedback  gain.  The  value  of  Gt  is  limited 

only  by  the  deliverable  torque  from  the  torque  motor  and  G2  follows  the  same 

damping  rule  as  K2  but  without  the  problem  of  signal  noise  generation.  The  model 

friction  due  to  the  bearings  and  wires  can  be  modeled  as  before.  Using  the  notation  X 
•  • 

in  place  of  8,  X  in  place  of  0,  pm  and  6m  replace  p  and  6.  the  model  friction  is 
expressed  by  Equation  2.8. 
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(eqn  2.8) 
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(eqn  2.9) 


X  -  X  -  6 
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(eqn  2.10) 


In  order  to  overcome  the  friction  torque  and  drive  the  model  to  0C,  the  torque  needed 
must  be  the  sum  of  the  two  torques  described  above.  The  predicted  torque  is  given 
below, 


xpred 


U  +  F 


m 


(eqn  2.11) 


To  correct  for  any  positional  and  velocity  errors  that  might  exist  between  the  model 
and  the  platform,  an  additional  correction  torque  based  on  the  amplified  error  signals 
are  added  to  the  predicted  torque  to  yield  the  total  required  torque,  expressed  in 
Equation  2.12  as. 


T,  -  V-  +  K,(X-«)  +  Kj(X-«) 


(tqn  2.12) 


where  the  second  term  corrects  the  positional  error  and  the  third  term  corrects  the 
velocity  error. 

This  software  based  model  is  described  in  Figure  2.5.  It  is  assumed  that  the  torque 
to  dri/e  the  platform  in  following  command  signals  can  be  expressed  as  the  sum  of  the 
torque  to  drive  an  ideal  platform  with  no  friction  plus  the  torque  required  to  overcome 
friction  as  established  by  the  ideal  platform  model.  Since  the  actual  platform  motion 
may  difTer  slightly  from  that  of  the  ideal,  a  correction  torque  is  added  based  on  a 
proportional  and  derivative  action  applied  to  motion  errors. 

F.  INPUT  SIGNAL  MODEL 

The  response  of  the  system  to  a  step  input  and  a  sine  input  is  simulated  using  the 
D.S.L.  simulation  program.  An  input  command  is  0.2  radians  for  all  simulations.  This 
is  equivalent  to  commanding  the  seeker  to  move  11.459  degrees.  The  step  input  is 
roughly  equal  to  an  initial  target  acquisition  phase  which  the  seeker  is  required  to  lock 
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Figure  2.5  Model- 


on  to  the  ttrgtt  or  when  the  target  is  stationary.  The  sinusoidal  input  simulates  the 
maneuvering  of  the  target  to  avoid  lock  on.  The  target  is  assumed  to  be  moving  at  2.5 
Hz.  This  type  of  maneuver  is  extreme  because  most  targets  are  not  able  to  evade  this 
quickly.  However,  most  missiles  flex  and  rotate  while  moving  through  the  air.  which 
makes  this  assumption  more  realistic. 
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III.  COMPUTER  SIMULATION  METHOD 


A.  INTRODUCTION 

Dynamic  Simulation  Language  (D.S.L.)  is  a  FORTRAN-based  simulation 
language  for  simulation  of  continuous  systems.  It's  strength  lies  in  its  built  in 
functions  which  allow  the  composition  ant!  simulation  of  any  physical  systems.  Some 
of  the  built  in  functions  include  integrators,  function  generators,  non-linear  functions, 
probability  distribution  functions,  and  linear  transfer  functions;  allow  easy  construction 
and  simulation  of  the  system  without  heavy  programing.  A  more  comprehensive  look 
at  the  capabilities  of  D.S.L.  can  be  found  in  References  4  and  5. 

B.  GEOMETRIC  DESCRIPTION 

The  platform  was  modeled  as  an  cy  linder  two  inches  in  diameter  and  three  and  a 
half  inches  in  height.  The  total  mass  of  the  cylinder  was  0.0029  slugs  plus  a  10%  out 
of  balance  mass  (0.0003  slugs).  The  inertia  of  the  cylinder  was  0.0037  lb-in-s2  The 
initial  distance  of  the  out  of  balance  mass  from  the  geometric  center  was  taken  to  be 
G.  1  inches  in  the  positive  Y  direction  and  0.2  inches  in  the  positive  Z  direction.  This 
distance  as  well  as  the  friction  and  control  parameters  were  varied  to  determine  their 
effects  on  the  performance  of  the  seeker. 

C.  ACCELERATION  SIMULATION 

The  effect  of  acceleration  is  simulated  under  an  assumed  flight  profile.  The 
maximum  acceleration  subjected  to  the  platform  is  assumed  to  be  an  exponential 
function  describes  by  Equation  3.1  and  3.2. 


Zm(l-EXP{-  ft,} 

t<t, 

(eqn  3.1) 

Z—EXP{  -  t/Tj} 

t>4r, 

(eqn  3.2) 

where  and  t2  are  some  arbitrary  constants. 

D.  DSL  CODING 

The  flow  chart  shown  in  Figure  3.1  illustrates  the  basic  structure  of  the  D.S.L. 
program  used  in  the  simulation  of  the  seeker.  The  program  is  divided  into  segments: 


TITLE,  CONSTANT,  PARAMETER.  INITIAL,  DYNAMIC,  DERIVATIVE.  AND 
TERMINAL,  The  TITLE  segment  named  the  program.  The  CONST  segment  defines 
the  constants  in  the  program  which  include  the  mass  properties  of  the  seeker  and  the 
maximum  acceleration.  PARAM  segment  defines  the  constants  wnich  will  be  changed 
frotw  one  simulation  run  to  the  next.  !t  defines  the  friction  characteristics  of  the  seeker 
model,  input  signals,  time  constants,  gain  constants,  and  the  geometry  of  the  out  of 
balance  mass.  The  INITIAL  segment  initializes  the  variables  and  calculates  the  values 
of  the  out  of  balance  gee  netry  and  velocity  feedback  constant.  The  DYNAMIC 
segment  calculates  the  acceleration  profile  of  the  seeker  and  the  input  signals.  This 
segment  is  computed  at  each  time  steps.  The  DERIVATIVE  segment  is  the  main  body 
of  the  program  It  consists  of  the  description  of  the  seeker  dynamics  as  well  as  the 
control  actions  being  used.  Finally,  the  last  segment,  TERMINAL,  contains  the 
commands  with  regard  to  the  total  simulation  time  desired  as  well  as  the  printing  and 
plotting  information. 

Appendix  A  presents  the  DSL  programming  codes  for  the  simulation  of  the 
classical  P.D.  and  P.I.D.  control  actions  and  Appendix  B  presents  the  DSL 
programming  code-  for  the  mod^l-reference  control  method.  The  symbol  "#"  means 
the  line  is  not  used  for  current  simulation. 


Figure  3.1  D.S.L.  Program  Flowchart 


IV.  SIMULATION  RESULTS 


A.  INTRODUCTION 

This  chapter  presents  the  results  of  the  Simula  %.on.  The  effect  or  friction,  control 
parameters,  and  control  schemes  on  the  tracking  accuracy  are  illustrated  by 
accompanying  figures.  Except  as  indicated,  all  figures  shown  the  command  signal,  0C, 
as  a  series  of  short  dashes  and  the  actual  response,  6  (TH),  as  a  solid  line.  The  actual 
torque,  Tx  (TX)  was  indicated  as  medium  length  dash  lines.  Most  of  the  figures  reflect 
the  response  to  the  sinusoidal  input,  and  tt‘so  contain  the  system  error  (THE)  as 
indicated  by  long  dash  lines.  Other  information  in  the  figures  include  the  error 
between  the  response  and  the  slider  (THERR).  This  piece  of  information  indicates 
how  the  slider  from  the  friction  model  relates  to  the  response.  The  pound(lb),  inch(in), 
second(sec)  system  was  used  through  out  the  simulation  process.  The  unit  of  torque 
was  lb-in.  The  unit  of  angular  displacement  was  in  radians  (rad).  The  velocity  and 
acceleration  were  in  rad  sec  and  rad  sec2,  respectively.  Mass  was  expressed  in  lb- 
sec2  in.  The  command  signal  amplitude  was  0.2  radians  (11.459  •)  and  the  simulation 
time  lasted  one  second. 

B.  EFFECT  OF  FRICTION  ON  ACCURACY 

This  section  discusses  the  effect  of  friction  on  the  system.  The  system  with  no 
friction  was  simulated  and  its  result  was  compared  with  the  same  system  with  various 
friction  level.  In  order  to  provide  a  meaningful  result,  all  the  simulation  variables 
except  p  must  remain  constant.  The  control  variables  Kt  and  6  were  set  at  15  lb- 
in  rad  and  0.05  in,  respectively.  The  value  of  K2  was  set  at  0.5  lb-in-sec.' rad.  Figures 
4.1  through  4.8  are  related  to  this  subject.  The  response  of  an  ideal,  balanced,  system 
with  no  friction,  to  a  step  input  is  shown  in  Figure  4.1  The  rise  time1  of  the  ideal 
response  was  0.12  seconds  with  no  steady  state  error.  Using  the  P.D.  control  scheme 
with  p  equals  to  0.1,  0.2,  and  0.3;  the  steady  state  error  increased  from  0.00667  to 
0.01333  and  to  0.02  radians,  respectively.  The  performance  of  the  P.I.D.  control  action 
was  better.  The  w-orst  steady  state  error  occured  when  p  equal  to  0.3  !b-in  was  only 


lThe  rise  time  was  taken  as  the  time  required  for  the  system  to  achieve  95%  of 
the  steady  state  value. 
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0.00424  radian*.  However,  this  better  accuracy  was  at  the  expense  of  rise  time  which 
was  0.24  second.  This  was  twice  as  slow  as  in  the  ideal  case.  A  comparison  of 
position  error  for  different  friction  level  at  different  gain  K,  was  shown  in  Figure  4.8. 
This  figure  also  shown  some  interesting  information.  It  was  expected  the  position 
error  would  increase  with  increase  friction  at  any  given  set  of  circumstances.  However, 
the  figure  indicated  that  although  it  w*as  true  in  general  there  were  cases  when  an 
increased  p  did  not  produce  a  higher  error.  For  example,  when  Kt  equal  to  10  lb- 
in  rad  the  position  error  for  p  equal  to  0.2  lb-in  had  a  higher  position  error  (2.5  milli- 
radians)  compared  to  0.84  milii-radians  for  p  equal  to  0.3  lb-in.  This  was  due  to  the 
nonlinearity  of  the  system.  A  particular  K2  combined  with  a  suitable  K,  and  6  would 
produce  a  better  error. 
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Figure  4.3  Kj-15.0,  K2~0.5,  6-U.05 
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Figure  4  8  Position  Error  Vs  Gain  Constant  Kj 
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C.  EFFECT  OF  THE  K  , 

The  usual  method  of  minimizing  the  influence  of  disturbance  forces  such  as  the 
frictional  load  is  to  increase  the  feedback  gain,  Kj,  so  that  system  "stiffness”  is 
increased.  However,  while  this  works  with  clean  signals,  the  effects  of  sensor  noise 
provides  a  limit  on  the  useful  range  of  Kj.  The  deliverable  torque  by  the  motor  also 
limits  the  values  of  Kj.  Figures  4.9  through  4.14  provide  graphical  results  to  different 
KjS.  A  high  Kj  value  drastically  reduces  the  position  error  of  the  system  as  shown  in 
Figure  4.8.  The  steady  state  error  decreased  from  73.88%  to  10%  when  K,  increased 
from  2  lb-in.  rad  to  15  lb-in  rad.  Like  wise,  the  positional  error  to  a  sinusoidal  input 
decreased  from  0.12559  radians  to  0.01764  radians  when  Kj  increased  from  15  lb-in  rad 
to  1000  lb-in  rad.  The  reponse  followed  the  command  signal  rather  well  at  the  higher 
K{  value  with  a  phase  shift  of  less  than  0.01  seconds.  The  torque  delivered  to  the 
system  was  also  higher,  an  increase  of  65%,  compared  with  the  lower  K,  value  of  15 
lb-in,  rad. 

D.  EFFECT  OF  SPRING  CONSTANT 

Figures  4.15  through  4.20  shown  the  effect  of  spring  stiffness  to  position  error. 
The  spring  constant,  6,  appeared  to  have  little  effect  on  the  steady  state  error  but  it  did 
affect  the  torque  delivery  to  the  platform.  A  very  stiff  spring,  small  6,  required  more 
torque  than  a  softer  spring  as  expected.  Indeed,  it  was  shown  in  Figures  4.15  and  4.16 
However,  this  logic  did  not  work  in  Figure  4.17.  The  torque  delivery  in  this  case  was 
higher.  The  effect  on  a  sinusoidal  input  was  a  little  different.  The  suffer  spring 
performed  poorer  than  the  softer  spring.  The  maximum  error  was  0.18527  radians  for 
the  stiff  spring  and  0.14129  radians  for  the  softer  spring.  However,  the  softer  spring 
i  .lowed  the  signal  a  little  better  than  the  stiff  spring.  The  time  lag  was  0.07  second  for 
*v e  stiff  spring  and  0.04  second  for  the  soft  spring.  Compares  with  the  ideal  case  where 
there  was  no  friction,  the  maximum  error  was  0. 1 2092  radians  with  a  time  lag  of  0.04 
seconds  as  shown  in  Figure  4.18. 
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Figure  4.9 


Figure  4.14  ji »  0.3,  K  1  *  1000.0,  i> ■  0.05,  Sin  Input 
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E.  EFFECT  OF  INTEGRAL  GAIN  TIME  CONSTANT 

The  benefit  of  an  integral  action  was  demonstrated  in  Section  B.  Th  s  section 
studied  the  effect  of  the  integral  time  constant.  When  the  time  constant  \  set  to 
unity  (Figure  4.5),  the  response  overshot  by  0.00188  radians  (0.94%)  and  then  settled 
back  to  0.20104  radians  at  the  end  of  one  second.  With  the  time  constant  increases  to 
2  and  3  seconds,  the  response  did  not  exhibit  any  overshoot  as  shown  in  Figures  4.21 
and  4.22.  It  did  indicate  that  as  the  time  constant  increases,  the  steady  state  error  also 
increases,  even  though  the  increase  was  small. 

F.  EFFECT  OF  G  , 

This  section  as  well  as  the  next  section  focuses  on  the  control  variables  Gl  and  p 
prediction  on  the  accuracy  of  the  seeker  using  the  model-reference  technique.  It  was 
shown  in  previous  sections  that  the  sinusoidal  input  produced  an  error  due  to  the 
inability  of  the  seeker  to  track  accurately,  even  in  the  case  where  friction  was  not 
present.  This  was  mainly  due  to  the  inability  of  the  P.D.  or  P.I.D.  control  action's 
failure  to  correct  the  inertia  effect  of  the  platform  in  a  timely  manner.  The  effect  of  Gj 
was  illustrated  in  Figures  4.23  through  4.25.  In  Figure  4.23,  the  maximum  error  was 
0.09086  radians  and  a  time  lag  of  0.03  seconds  with  Kj  and  Gj  both  equal  to  30.  It  is 
interesting  to  observe  that  the  performance  did  not  degrade  even  though  the  value  of 
Kj  was  reduced  by  half  provided  the  value  of  Gt  was  high.  In  fact,  the  performance 
can  be  improved  by  increasing  Gt  As  shown  in  Figure  4.24  and  4.25,  both  the 
maximum  error  and  time  lag  were  drastically  reduced  to  0.02417  rad  and  0.01  rad  as  Gt 
increases  to  500  and  3000,  respectively.  The  amount  of  time  lag  also  cut  by  a  third  to 
less  than  0.01  second.  Although  the  value  of  Gj  was  arbitrary,  it  was  not  without 
bound.  The  maximum  usable  value  depends  on  the  size  of  the  torque  motor. 


Figure  4.19  y-0.3,  Kt  =  5.0,  5*0.01,  Sin  Input 


Figure  4.21  ,i,  Kj »  15.0,  5 “0.05,  PID  Control,  Tj 


G.  EFFECT  OF  p  PREDICTION  ERROR 

The  main  advantage  of  the  model-reference  control  scheme  is  its  ability  to  predict 
the  response  of  the  system  using  an  ideal  model.  Figures  4.26  through  4.29  study  the 
sensitivity  to  an  erroneous  prediction  of  the  friction  level  in  the  system.  Friction  levels 
of  p  equal  to  0.1  to  0.5  with  an  increment  of  0.1  were  simulated.  The  results  indicated 
that  a  wrong  prediction  did  make  a  difTerence.  The  maximum  errors  in  order  of 
increasing  p  were  0.01692,  0.01862,  0.01,  0.01368,  and  0.01845.  A  smaller  system 
friction  than  predicted  tends  to  cause  overshoot  while  a  larger  system  friction  causes 
the  response  to  be  a  little  short.  In  the  sinusoidal  input  response,  the  corrective  torque 
was  trying  to  correct  the  overshoot  but  it's  effectiveness  was  quite  limited.  This 
problem  can  be  corrected  by  adaptive  control  action.  Very  often,  the  model-reference 
action  was  used  with  adaptive  control. 

H.  EFFECT  OF  UNBALANCED  SYSTEM 

The  effect  of  the  out-of-balance  appeared  to  be  quite  minimal  as  shown  in  Figures 
4.30  through  4.32.  The  response  typically  reached  a  maximum  values  early  on,  usually 
within  the  first  0.12  seconds,  then  it  droped  slowly  as  the  acceleration  reached 
maximum  acceleration.  After  the  platform  reached  the  maximum  acceleration  and 
started  to  decelerate,  the  response  rose  again.  As  the  distance  between  the  center  of 
gravity  and  the  out  of  balance  mass  increased,  the  accuracy  decreased.  Therefore,  It  is 
important  to  consider  the  effect  of  out-of-balance  mass  in  platform  design. 
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I.  EFFECT  OF  ACCELERATION 

The  effect  of  acceleration  was  similar  to  that  of  the  C.G.  location.  The  response 
began  to  drop  as  the  acceleration  approached  maximum  and  recovered  when  the 
platform  started  to  decelerate.  This  phenomenon  was  true  for  both  the  P.O.  and 
model-reference  control  schemes  shown  in  Figures  4.33  through  4.36  with  either  step 
input  or  sinusoidal  input.  However,  the  model-reference  action  allowed  a  much 
quicker  recovery  than  the  P.D.  action.  This  was  due  to  the  correction  torque  provided 
by  the  model.  Furthermore,  the  P.D.  action  had  a  much  greater  positional  error  while 
responsed  to  a  step  input  and  a  slower  response  to  a  sinusoidal  input. 
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V.  DISCUSSION  AND  RECOMMENDATION 


A.  INTRODUCTION 

This  chapter  summaries  the  results  obtained  from  the  D.S.L.  simulation  and  make 
recommendations  for  future  work  in  this  area. 

B.  DISCUSSION 

The  model-reference  control  method  described  here  offered  better  tracking 
accuracy  than  either  the  P.D.  or  P.I.D.  actions.  It  also  minimized  the  problem  of 
noisy  feedback  signals.  This  software  based  model  utilizes  an  idealized  model  as  a 
reference  to  predict  the  torque  needed  to  overcome  friction  and  gimbal  dynamics  and 
produce  zero  position  error.  First,  the  amount  of  torque  needed  to  drive  an  idealized 
platform  with  no  friction  is  predicted.  Then,  the  torque  required  to  overcome  friction 
is  determined  from  the  friction  model  described  in  Chapter  II.  The  sum  of  these  two 
produced  a  predicted  torque  Txprtd.  In  addition,  the  idealized  platform  velocity  X  is 
compared  with  the  actual  velocity  0  and  the  error  is  amplified.  Similarly,  the  ideal 
position  X  is  compared  with  the  actual  position  0  and  the  error  is  amplified  also.  A 
corrective  action  occurs  when  these  amplified  error  signals  are  added  to  Txpred  to  yield 
the  total  required  torque  Tx.  The  result  is  a  highly  tuned,  high  accuracy,  control 
action.  Since  the  reference  model  is  ideal,  it  does  not  have  the  draw  back  of  large  noise 
amplification  as  the  other  two  control  schemes  do.  Therefore,  it  is  reasonable  to 
expect  better  target  tracking,  even  if  the  noise  level  is  high. 

The  simulation  results  clearly  shown  the  superior  tracking  accuracy  provided  by 
the  model-reference  method.  The  level  of  accuracy  achieved  is  adequate  for  most 
target  tracking  seekers.  Although  this  study  was  limited  to  the  Y-Z  plane  only,  this 
exercise  did  provide  a  better  and  clearer  understanding  of  how  friction  and  control 
variables  affect  the  performance  of  the  seeker.  Of  course,  the  performance  of  a  missile 
seeker  is  affected  by  many  other  variables,  not  discussed  here.  The  effect  of  vibration 
as  the  missile  moves  through  the  air,  or  the  effect  of  air  blast  in  the  vicinity  of  the 
missile  are  examples  of  disturbance  which  will  play  an  important  role  in  the  tracking 
accuracy  of  the  missile.  The  friction  model  presented  here  is  more  realistic  than  simple 
coulomb  friction  model  which  produces  an  underfined  friction  force  when  0S  is  equal  to 
zero.  The  model  presented  here  does  allow  non-zero  friction  force  under  stationary 
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conditions.  Improvements  can  be  made  on  the  model-reference  method  to  have 
adaptive  capability  to  take  into  consideration  the  external  disturbances,  and 
variabilities  in  actual  friction. 

C.  RECOMMENDATION 

It  is  recommended  that  an  experimental  follow  up  be  made  to  compare  with  the 
results  obtained  by  analytical  means.  Frictional  effect  is  not  the  only  element  affect 
seeker  performance.  There  are  other  problem  areas  which  also  deserve  the  attention 
given  here;  among  them  vibration,  shock,  and  random  noise  effects.  It  will  be 
interesting  to  subject  the  model-reference  control  method  described  here  to  these 
external  disturbances  to  see  how  well  or  how  poor  the  current  method  handles  these 
problem.  These  disturbances  can  be  incorporated  into  the  model-reference  algorithm 
so  their  effects  will  be  minimal.  There  are  also  an  abundance  of  research  in  adaptive 
control.  This  type  of  control  action  enables  a  control  system  such  as  the  one  described 
here  the  ability  to  "learn  and  adjust"  the  model  to  different  signal  input.  This  latest 
technique  is  most  versatile  and  would  definitely  contribute  to  the  tracking  accuracy  of 
the  seeker. 
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APPENDIX  A 

DSL  LISTINGS  (PD,  PID  CONTROL) 


TITLE  GIMBAL  DYNAMICS 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA AAAAAAAAAAAA AAAAAAAAAAAAAAA AAAAA 


* 

* 

A 

A 

A 

A 

A. 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 


AUTHOR t  JOSEPH  CHAN 

ABSTRACT*  THIS  PROGRAM  SIMULATES  THE  MOTION  OF  A  SINGLE 
GIMBAL  SYSTEM  WHILE  SUBJECTS  TO  STEP  AND  SINUSOIDAL 
EXCITATIONS.  PD  AND  PID  CONTROL  ACTION. 


SYMBOLS  > 
BM 

DELTA 
F 

IM 
K1 
K2 
MU 

PERIOD 
PH 
R 

SM 
TAU1 
TAU2 
TH 
THO 

TH2DOT 
THCOM 
THDO 
THDOT 
THE 
THS 
TIME 
TX 
YO 
ZO 

Z2DOT 
ZM 


MASS  OF  THE  CYLINDER. 

CHAR.  DISP  FOR  COULOMB  FRICTION  MODEL. 

BEARING  FRICTION  FORCE. 

MASS  MOMENT  OF  INERTIA  OF  CYLINDER. 

TORQUE  GAIN  CONSTANT. 

VELOCITY  FEEDBACK  CONSTANT. 

COEFFICIENT  OF  FRICTION. 

PERIOD  OF  THE  SINE  INPUT. 

ANGLE  BETWEEN  THE  Y-AXIS  AND  R. 

DISTANCE  TO  THE  OFF-CENTER  MASS  FROM  THE  ORIGIN. 
OUT  OF  BALANCE  MASS. 

ACCELERATION  TIME  CONSTANT  (INITIAL  PHASE). 
ACCELERATION  TIME  CONSTANT  (FINAL  PHASE). 
ANGULAR  DISPLACEMENT  OF  THE  CYLINDER. 

INITIAL  ANGLE  ROTATION. 

ANGULAR  ACCELERATION. 

COMMAND  ANGLE  INPUT. 

INITIAL  ANGULAR  VELOCITY. 

ANGULAR  VELOCITY. 

ANGULAR  DISPLACEMENT  OF  THE  CYLINDER. 

POSITION  OF  THE  SLIDER.  (FRICTION  MODEL) 
SIMULATION  TIME. 

MOTOR  TORQUE. 

DISTANCE  TO  OFF  CENTER-MASS  IN  THE  Y  DIRECTION. 
DISTANCE  TO  OFF  CENTER-MASS  IN  THE  Z  DIRECTION. 
LINEAR  ACCELERATION. 

MAXIMUM  LINEAR  ACCELERATION. 


a 

* 

A 

A 

A 

A 

.A 

A 

A 

A 


A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 


AAAAAAAAAAAAAAAaAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA A 

*  GIMBAL  PARAMETERS  * 

A A A A AAA AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA AAAAAAA AAAAAAAAAA A AAA A A A A A A 
A 


CONST  BM«0. 00290, 

*  LB-S**2/IN 

PARAM  Kl-15.000, 

*  LB-IN/RAD 


SM-0. 00030, 
LB-S**2/IN 


ZM-0.0000, 

IN/S**2 


MU-0.3, 


DELTA-0.05, 

IN 


PARAM  Y0-0.1, 
*  IN 

A 

INITIAL 

R 

PH 

K2 

F 

TH 

THO 


Z0-0.2,  TAU1-0.5,  TAU2-0.5, 

IN  SEC  SEC 


SQRT(Y0**2+Z0**2) 

ACOS(YO/R) 

SQRT(8*IM*K1) 

0.0 

0.0 

0.0 


IM-0. 00370 
LB-IN-S**2 

PERIOD-O .4 
SEC/CYC 

THMAX-0 . 2 
RAD 
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THDO 

B 

0.0 

THDOT 

a 

0.0 

THE 

s 

0.0 

THEO 

X 

0.0 

THERR 

2 

0.0 

THS 

* 

0.0 

DYNAMIC 

* 

********************************************************************** 

*  ACCELERATION  PROFILE  * 

************************ A*******  ***************************  *********** 

* 

T1  =  TIME-4. 0*TAU1 

Z2DOT  -=  ZM*(1. 0-EXP  (-TIME/TAU1) ) 

IF  (TIME.GT. v4.0*TAUl)j  THEN 
Z2DOT  *  ZM*EXP ( -T1/TAU2 ) 

END  IF 

* 

*  SINUSOIDAL  EXCITATION 

* 

*  THCOM=THMAX*SIN(2*PI*TIME/PERIOD) 

*  STEP  INPUT 

* 

THCOM-THMAX 


DERIVATIVE 

NOSORT 

* 

********************************************************************** 

*  BEARING  FRICTION  MODEL  * 

******* a************************************************************** 

* 

THERR  =  TH-THS 

F  =  MU* (THERR) /DELTA 

IF  ( (ABS(F)) . LT.MU)  THS  =  THS 

IF  ((ABS(F)).GT.MU)  THS  *  TH-DELTA*F/ABS(F) 

********************************************************************** 

*  MOTOR  TORQUE  MODEL  * 

********************************************************************** 

* 


THE  =  THCOM-TH 

* 

*  PD  FEEDBACK 

* 

*  TX  =  K1 *( THE )-K2*( THDOT) 

*  PID  FEEDBACK 

* 

TX  =  Kl*(THE)-K2*THDOT+(Kl/TI)*Y 

TH2DOT  *  (TX-F-SM*Z2DOT*R*(COS (TH)*COS (PH)-SIN(TH)  ... 

*SIN(PH) ) )/ (IM+SM*R**2) 

THDOT  =  INTGRL (THDO , TH2DOT ) 

TH  *  INTGRL1TH0, THDOT) 

#  Y  *  INTGRL ( THE 0, THE) 

METHOD  RK5 

CONTRL  FINTIM»1 .00,  DELT=0.001 

* 

********************************************************************** 

*  PRINT  RESULTS  * 

********************************************************************** 

* 

SAVE  0.001,  TX,  F,  THCOM ,  TH,  THE,  THERR 
PRINT  0.010,  TX,  F,  THCOM,  TH,  THE,  THERR 

*  THETA  VS  TTME 

* 

#GRAPH  (A,DE=TEK618)  TIME (LE=8,UNIT=‘ SEC ' )  TH(LO=-.3,SC=.l,NI=6,  ... 


68 


#  UN* 'RAD' )  THCOM(AX«OMIT,LO— .3,SC*0.1,NI-6,LI»4,UN*'RAD') 

#  THE (LO*- .3, SC*. 1 ,NI*6 ,Lf-2) ,  TX(LI«3,UN*'l6-IN' j 

GRAPH  (A.DE-TEK618)  TIME (LE-8 .UNIT- 1  SEC ' )  tH(LO*0.0,SC*.04,NI=8,  . 
UK* 'RAD')  THCOM ( AX-OMIT , L0*0 . 0 , SC*0 . 04 , NI*8 , LI*4 , UN* ' RAD ' ) 
TX(LI«3,UN*'LB-IN') 

LABEL  (A)  MU-0.3,  Kl*15.0,  DELTA-0.05 

J  THETA  VS  TIME  WITH  THETA  COMMAND  AS  REFERENCE  (SINE  INPUT) 

#GRAPH  (A,DE*TEK618)  TIME (LE-8, UNIT*' SEC ' )  TH(LO— 0.3, SC-0.1, NI*6, 

#  UN- ' RAD ' )  THCOM(LO— 0.3, SC-0.1, NI*6, LI-4, UN-'RAD’ ) 

#  HYSTERISIS 

•k 

#GRAPH  (B,DE-TEK618)  TH(LE*8,P0*2, 4, AX-LIN, DRAW, UN-RAD)  F(UN-'LB') 
# LABEL  (A,B)  MU-0.25,  Kl-2.00,  K2-0.05,  DELTA-0.050 


J  TIME  RESPONSE 


#GRAPH  (C.DE-TEK618)  TIME (LE-8. UN-' SEC' )  TH 

#  LI-1,  UN- 'RAD')  THSTlO—  .3 ,SC= . 1 .NI-6 ,LI-2,UN 

#  F (LO— . 3, SC- .  1  ,NI=6 , LI-4 , UN- ' LB !  ) 

# LABEL  (C)  TIME  HISTORY 

# 

END 

STOP 


TH(LO— .  3 ,  SC- .  1  .NI-6 , 
-  RAD1)  ... 


69 


APPENDIX  B 

DSL  LISTINGS  (PC  CONTROL) 


TITLE  GIMBAL  DYNAMICS 2 
a 

a********************************************************************* 


* 

* 

* 

A 

A 

A 

A. 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 


AUTHOR :  JOSEPH  CHAN 

ABSTRACT i  THIS  PROGRAM  SIMULATES  THE  MOTION  OF  A  SINGLE 
GIMBAL  SYSTEM  SUBJECTS  TO  STEP  AND  SINUSOIDAL  EXCITATIONS 
USING  PREDICTION  CORRECTION  CONTROL  ACTION. 


SYMBOLS i 
BM 

DELTA 

DELTAM 

F 

FM 

G1 

G2 

IM 

K1 

K2 

MU 

MUM 

PH 

R 

SM 

TAU1 

TAU2 

TH 

THO 

TH2DOT 

THCOM 

THDO 

THDOT 

THE 

THS 

TIME 

TX 

TXPRED 

X 
XO 

XI 

X2DOT 

XDOT 

XDOTO 

XS 

YO 

ZO 

Z2DOT 

ZM 


MASS  OF  THE  CYLINDER. 

CHAR.  DISP  FOR  COULOMB  FRICTION  MODEL. 

CHAR.  DISP  FOR  COULOMB  FRICTION  (REFERENCE  MODEL). 
BEARING  FRICTION  FORCE. 

BEARING  FRICTION  FORCE  (REFERENCE  MODEL). 

REFERENCE  MODEL  TRANSFER  FUNCTION. 

REFERENCE  MODEL  TRANSFER  FUNCTION. 

MASS  MOMENT  OF  INERTIA  OF  CYLINDER. 

TORQUE  GAIN  CONSTANT. 

VELOCITY  FEEDBACK  CONSTANT. 

COEFFICIENT  OF  FRICTION. 

COEFFICIENT  OF  FRICTION  (REFERENCE  MODEL). 

ANGLE  BETWEEN  THE  Y-AXIS  AND  R. 

DISTANCE  TO  THE  OFF-CENTER  MASS  FROM  THE  ORIGIN. 
OUT  OF  BALANCE  MASS. 

ACCELERATION  TIME  CONSTANT  (INITIAL  PHASE). 
ACCELERATION  TIME  CONSTANT  (FINAL  PHASE). 

ANGULAR  DISPLACEMENT  OF  THE  CYLINDER. 

INITIAL  ANGLE  ROTATION. 

ANGULAR  ACCELERATION. 

CONTROL  ANGLE  INPUT. 

INITIAL  ANGULAR  VELOCITY. 

AMGUT  AH  VELOCITY 

ANGULAR  DISPLACEMENT  OF  THE  CYLINDER. 

POSITION  OF  THE  SLIDER.  (FRICTION  MODEL) 
SIMULATION  TIME. 

MOTOR  TORQUE. 

MOTOR  TORQUE  (PREDICTED) 

DISTANCE  OF  MASS  AT  ANY  TIME  T.  (FRICTION  MODEL) 
INITIAL  DISTANCE  OF  REFERENCE  MODEL. 

DISTANCE  MOVED  BY  THE  SLIDER.  (FRICTION  MODEL) 
ACCELERATION  OF  REFERENCE  MODEL. 

VELOCITY  OF  REFERENCE  MODEL. 

INITIAL  VELOCITY  OF  REFERENCE  MODEL. 

POSITION  OF  SLIDER  (REFERENCE  MODEL). 

DISTANCE  TO  OFF  CENTER-MASS  IN  THE  Y  DIRECTION. 
DISTANCE  TO  OFF  CENTER-MASS  IN  THE  Z  DIRECTION. 
LINEAR  ACCELERATION. 

MAXIMUM  LINEAR  ACCELERATION. 


* 

* 

* 

* 

* 

a 

.A 

* 

* 

* 

* 

A 

A 

* 

* 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 

A 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

*  GIMBAL  PARAMETERS  * 

********************************************************************** 

* 


CONST  BM*0. 00290, 
*  LB-S**2/IN 


SM=0. 00030, 
LB-S**2/IN 


ZMa0 . 0000 , 
IN/ S**2 


IM=0. 00370 
LB-IN-S**2 


PARAM  Kla150000 ,  MUa0.3,  DEI,TA=0.05,  PERIOD*0.4 
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*  LB-IN/RAD  IN  SEC/CYC 

PARAM  01*500.00,  MUM=0.3,  DELTAM=0 .05 ,  THHAX=0.2 

*  IN  RAD 

PARAM  Y0=0.1,  Z0=0.2,  TAU1=0.5,  TAU2=0.5 

*  IN  IN  SEC  SEC 

* 


INITIAL 

R 

PH 

K2 

G2 

F 

TH 

THO 

THDO 

THDOT 

THE 

THEO 

THERR 

THS 

X 

xo 

XDOT 

XDOTO 

X2D0T 

xs 


=  SQRT(Y0**2+Z0**2) 
=  ACOSi YO/R) 

=  SQRT(8*IM*K1) 

=  SQRT(8*IM*G1) 

=  070 
=  0.0 
=  0.0 
=  0.0 
=  0.0 
=  0.0 
=  0.0 
=  0.0 
=  0.0 
=  0.0 
=  C.O 
=  0.0 
=  0.0 
=  0.0 
=  0.0 


DYNAMIC 

* 

********************************************************************** 

*  ACCELERATION  PROFILE  * 

********************************************************************** 

* 

T1  =  TIME-4. 0*TAU1 

Z2D0T  -  ZM* ( 1 . O-EXP ( -TIME/TAU1 ) ) 

IF  (TIME.GT. (4.0*TAU1))  THEN 
Z2D0T  =  ZM*EXP(-T1/TAU2) 

ENDIF 

* 

*  SINUSOIDAL  EXCITATION 

* 

*  THCOM=THMAX*S IN ( 2 *P I *T IME / P ERIOD ) 

*  STEP  INPUT 

* 

THCOM=THMAX 

* 


DERIVATIVE 

NOSORT 

* 

**************************************** * ******** ft*** ****** ft***** * **** 

*  MODEL  REFERENCE  DYNAMICS  * 

********************************************************************** 

* 

U  =  (THC0M-X)*G1-G2*XD0T 

X2D0T  =  U/(IM+SM*R**2) 

FM  =  MUM/DELTAM*(X-XS ) 

IF  { (ABS(FM) } .LT.MUM)  XS  =  XS 
IF  (<ABS(FM)).GT.MUM)  XS  =  X-DELTAM*FM/ABS(FM) 

TXPRED  *  U+FM 

* 

**********5":******************  *****  *  ************************  A********** 

*  '  BEARING  FRICTION  MODEL  * 

********************************************************************** 

* 


THERR  =  TH-THS 

F  =  MU*(THERR) /DELTA 

IF  ( (ABS(F) ) .LT.MU)  THS  =  THS 
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IF  ((ABS(F)) .GT.MU)  THS  »  TH-DELTA*F/ ABS ( F ) 


********************************************************************** 

*  MOTOR  TORgUE  MODEL 

********************** 

* 

THE  -  THCOM-TH 


TX  «  TXPRED+K1* (X-TH) +K2* ( XDOT-THDOT) 

IF  (TX.GT.55.0)  TX-55.0 

TH2DOT  *  (TX“F“SM*22DOT*R*(COS(TH)*COS (PH 


*SIN (PH) ) ) / ( IM+SM*R**2 


*COS (PH)-SIN(TH)  ... 


2D0T) 


4  I  »itWW  f  *  •  tfcVW 

*  INTGRL (THO ,  THDOT ) 
«  INTGRL (X0,XD0T) 

*  INTGRL (XDOTO,X2DO 


THDOT  *  INTGRL (THDO.TH2DOT) 

TH  *  INTGRL  THO, THDOT) 

X  «  INTGRL (XO,XDOT) 

XDOT  *  INTGRL (XDOTO ,X2DOT) 

METHOD  RKS 

CONTRL  FINTIM*1.00,  DELT-0.0001 
* 

********************************************************************** 

*  PRINT  RESULTS  * 

********************************************************************** 

* 

SAVE  0.001,  TX.  TXPRED.  F,  THCOM,  TH,  THE,  THERR 
PRINT  0.010,  TX,  TXPRED,  F,  THCOM,  TH,  THE,  THERR 

J  THETA  VS  TIME 

#GRAPH  (A.DE-TEK618)  TIME (LE-8, UNIT-' SEC ' )  TH(L0— .3  ,SC*.  1  .NI-6 ,  ... 

#  UN* 'RAD' )  THCOM(AX=OMIT,LO— .3, SC-0.1. NI*6, LI-4, UN«'RAD')  ... 

#  THERR(L0— .3.SC-.1.NI-6,LI«2).  TX(LI-i) 

GRAPH  (A,DE*TEK618)  TIME (LE*8 .UNIT-' SEC ' )  TH(LO»0.0,SC«.04,NI*8,  ... 

UN* 1  RAD 1 )  THCOM( AX-OMIt , L0*0 . 0 , SC*0 . 04 , NI*8 , LI-4 , UN* 1  RAD 1 )  ... 
TX(LI*3) 

LABEL  (A)  MU-0.3,  Kl*1000,  DELTA-0.05,  MUM-0.3,  DELTAM-0.05,  Gl*1000 

*  THETA  VS  TIME  WITH  THETA  COMMAND  AS  REFERENCE  (SINE  INPUT) 

#GRAPH  (A.DE-TEK618)  TIME (LE-8, UNIT** SEC ' )  TH(LO— 0.3,  SC-0.1, NI-6,  ... 

#  UN*  RAD ' )  THCOM (LO»- 0.3, SC-0.1 ,NI*6, LI-4, UN*1 RAD' ) 

*  HYSTERISIS 

* 

#GRAPH  (B.DE-TEK618)  TH(LE»8. PO-2, 4, AX-LIN, DRAW, UN-RAD)  F(UN-'LB') 

#LABEL  (A,B)  MU-0.25,  Kl-2.00,  K2-0.05,  DELTA-0.050 
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